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TITLE OF INVENTION 
Name: Gary John Corey 
Citizenship: United States of America 

Residence: 21445 Bundy Canyon Drive, VTildomar, California, USA, 92595 

Title of Invention: Multi-Axes Tool Compensation - 3D and 5-axis teal-time interactive 
tool compensation inside the CNC machine tool controller. 

CROSS-REFERENCE TO RELATED APPLICATIONS: Not Applicable 

STATEMENT REGARDING FEDERALLY SPONSORED RESEARCH OR 
DEVELOPMENT: Not.Applicable 

REFERENCE TO A COMPUTER PROGRAM LISTING COMPACT DISK 
APPENDIX 

The Appendix contains two copies on compact disk of the entire Multi-Axes Tool 
Compensation computer program listing in standard ASCII character file format. Each 
compact disk contains the same single file entitled MTC.TXT. 

BACKGROUND OF THE INVENTION 

Multi-Axes Tool Compensation for 3D and 5-axis real-time interactive tool 
compensation relates to CNC machining techniques that are already in common practice 
for 2D tool compensation in CNC machining. 

The ^plicable US patent Classification Definition to my invention is found in 
category 700 DATA PROCESSING: GENERIC CONTROL SYSTEMS OR SPECMC 
APPLICATIONS for Sub Class 1 GENERIC CONTROL SYSTEM, APPARATUS OR 
PROCESS. 

Below are references to specific documents, articles and technical meetings 
related to my invention. 
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Presentations by: 

Charles Farah 

Norm Lamar& Jim Bums (San Diego State University) 
Glenn Coleman 
Francois Lamy 

BRIEF SUMMARY OF THE INVENTION 

The object of Multi-Axes Tool Compensation is to provide CNC machinists using 
CNC controllers a convenient method for applying 3D and 5-axis tool compensation in 
real time directly within the CNC controller as they now enjoy when using the traditional 
2D tool comp standards G41 and G42, Before my invention CNC controllers have not 
been technically advanced enough to employ multi-axes tool compensation methods. 
Using the technology methods of my invention for multi-axes tool compensation, the 
machine operator now has a pre-defined method to assign 3D and 5-axis tool 
characteristics at the CNC controUer. CNC programmers and machinists now have the 
tools to issue 3D and 5-axis tool comp commands, which have not been available in 
traditional CNC controllers. 
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The CNC machine operator will no longer require the assistance of the CNC 
programmer to re-create a brand hew CNC G code Program with new tool positions and 
definitions vvhen a change is made. My invention allows the CNC machine operator to 
easily define the new tools using my complex 3D and 5-axis tool compensation 
algorithms built into the CNC Controller. These algorithms also provide for automatic 
tool gouge avoidance protection. 

BRIEF DESCRIPTIONS OF THE SEVERAL VIEWS OF THE DRAWINGS 

FIG L is the operator interface screen that users use to enter in the tool size and 

offsets. 

FIG 2. individually labels the various dimensions used in the calculations of 
Multiple-axis Tool Compensation. 

FIG 3. isolates one of the key pivot points used in the calculation. 

FIG 4. shows a side view to further depict the angular dimension used in the 
calculation. 

FIG 5. isolates the dimension that depicts the included angle of the tool tip when a 
ball nose cutter is used. 

FIG 6, shows a fiiU isometric 3D view of the multiple axis head and further points 
out another key dimension used in the calculation. 

FIG 7. is an isometric view of a CNC machine tool using a multi-axes cutting tool 
mounted in a tool holder cutting a conceptual part. 

no 8. is a side view of a CNC machine tool using a multi-axes cutting tool 
mounted in a tool holder cutting a conceptual part 
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FIG 9. is a multi-axes G Code program, commonly used in CNC machining, 
listing the non-compensated axis positions as X, Y,Z ,A3 coordinates. These coordinates 
are read into the system to provide a list of positions to drive the tool to and a tool 
number listed as "T" to provide a means to look up the user-inserted desired tool size 
values, as shown in FIG to be used in calculating the compensation amounts. 
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DETAILED DESCRIPTION OF THE INVENTION 

FIG 1, illustrates an operator screen where the machine operator enters the Multi- 
Axes Tool Compensation values. The user first starts out by entering the tool size as 
shown on FIG 1 . in the box labeled "Size". This describes the tool diameter that will be 
5 used by the internal algorithm to compensate or adjust for this size tool when cutting a 
part on a multi-axes machine. On FIG 1 . the box labeled "Horz" is used by the machine 
operator to enter the horizontal offeet value that will be used to compensate for fte tool 
location horizontally. On FIG 1. the box labeled "Vert" is used by the machine operator 
to enter the vertical offset value that will be used to compensate for the tool location 
10 verticaUy. On FIG 1. the box labeled "Height" is used by the machine operator to enter 
the height offset value that will be used to compensate for" the tool location in regards to 
the tallest or length of the tool. On FIG I. the box labeled "Wear" describes the wear 
amount to be deducted from the tool diameter when the tool begins to wear out so that the 
true tool diameter can always be compensated. On FIG 1 . the boxes labeled "Custom 1 

1 5 and Custom2" are reserved for future user-defined values. On FIG 1 . the box labeled 
"Comer radius" is used to enter a value by the machine operator that would be used by 
the internal algorithm to compensate or adjust for the radius on the end of the tool as 
shown in FIG 2. item (1). On FIG 1. the box labeled "Bottom angle" is used to enter a 
value by the machine operator that would be used by the internal algorithm to 

20 compensate or adjust for the angle on the bottom of the tool as shown in FIG 5. Dim "E" 
item (7). On FIG 1 . the box labeled "Side angle" is used to enter a value by the machine 
operator that would be used by the internal algorithm to compensate or adjust for the side 
angle on the side of the tool. On FIG 1 . the box labeled "Length" is used to enter a value 
by the machine operator that would be used by the internal algorithm to compensate or 

25 adjust for the actual length of the tool itself as shown in FIG 2. Dim "C" item (4). On 
FIG 1 . the box labeled "Type" is the type or kind of tool style. The values to be entered 
vary ftom machine type to machine type and actaally only provide a reference number to 
the machine operator as to which type of tools he uses for that particular machine type. 
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For instance: 

30 Type 0=Flat Ended Mill 

l=DrillMUl or Lathe 

2=Diamond Insert Lathe 

3=Ball Nose Mill 

4=Custom 
35 5=Circle Insert Lathe 

6=Triangle Insert Lathe 

7=Groove or Part Off Tool Lathe 

Whereas to fiirther describe the values to enter on FIG 1 .: 

Comer radius: Is the comer radius of tte tool l/2=ball nose, <= Bull nose cutter. 
40 Bottom angle: Is the angle measured from the center tip out. Typically 28 for a drill. 
Side angle: Is the angle measured on the cutter's side, like a draft angle or taper. 
Length: The overall tool length. 



Comer radius same as Param 1 
45 Bottom angle same as Param2 
Side angle same as Param3 
Length same as Param4 

2=Diamond Insert Lathe 
Param 1 =Nose radius (Default= 03) 
50 Param2 = Included angle of insert (Default=80) 
Param3 = Mounting angle (Default=45) 
Param4 = Length (Default will size to part) 

5=Circle Insert Lathe 
Param I = Circle radius (Default^.03) 
55 Param2 = Not used 
Param3 = Not used 
Param4 = Not used 

6=TriangIe Insert Lathe 
Param 1 = Nose radius (Default=.03) 
60 Param2 = Mounting angle (Default=0) 
Param3 = Not used 

Param4 = Insert size (Default will size to part) 
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7=Groove or Part Off Tool Lathe 
Paraml = Comer nose radius (Default=.03) 
65 Param2 = Width (Default=.0^ 
Param3 = Not used 
Param4 = Lei^ (Default=2) 

For a Lathe the settings mean: 

SIZE: Tool nose radius 
70 HORZ: The amount and direction of the Z offset from the tool radius center to the 
cutting edge. 

VERT: The amount and direction oftheXoflfeet from the tool ladius center to the 
cutting edge. 

HEIGHT: Not Used 

75 WEAR: The amount to add or subtract from the Tool Nose Radius caused by tool 
wear. 

For non-lathe 3 or more axis smgle head or spindled machines the settings mean: 

SIZE: Tool Diameter 
HORZ: Not used 
80 VERT: Not used 

HEIGHT: Tooilengdi offeet. The amount and direction to offset the Z axis. 
WEAR: The amount to add or subtract from the tool diameter caused by tool wear. 

For a non-lathe 2 axis machine the settings mean (Waterjet, Laser, Plasma, EDM): 

SIZE: Kerf or Tool Diameter. 
85 HORZ: Not used 
VERT: Not used 
HEIGHT: Not used 

WEAR: The amount to add or subtract from the tool diameter caused by tool wear. 
For a non-lathe Multi-head or spindled machine. 

90 SIZE: Tool Diameter. 

HORZ: The amount or distance and direction of oflfset on each head in the X axis 
from the main head. 

VERT: The amount or distance and direction of offset on each head in tiie Y axis 
from the main head. 

!J^'^?^' direction to offset the Z axis 

WEAR: The amount to add or subtract from the tool diameter caused by tool wear. 

On FIG 1 . the group of boxes under the section MACHINE OFFSETS is described as 

lollows: 
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Whenever you zero out the machine's home position, these are the values the 
1 00 machine thinks it is at. Generally, you would home the machine at zero for all axes. 
Ignore the values for axes you do not have. 

On FIG 1. the group of boxes under the section FDCTURE OFFSETS is described 
as follows: 

These are values for all 6 axes. Ignore the values for axes you do not have. These 
1 05 OFFSETS are only added when an OFFSET logic command is issued generally with G54 
through G59 codes. The oflfeet values entered for each axis will be added to the current 
position of the tool together with all other invoked offsets. These are typical G codes, as 
known by industry standards, which refer to machine offsets. 

On FIG 1 . the group of boxes under the section OPTIONAL SETTINGS is 
110 described as follows: 

This is an array of miscellaneous settings that do not directly relate to features 
needed for multiple-axes tool comp. They are presented here to fully disclose how 
multiple-axes tool comp interacts with the various other operator settings and choices. 

1 1 < ^ 0° °^ a mode m which the Z axis. Spindle and Feed 

115 mode will be disabled or not Commonly used in test runs. 

BniMAP G CODE DISPLAY will refresh the GCODE window whenever another 
wmdow pops up over it. 

GRAPHICS: SOLID VS WIREFRAME switches the graphics display to either a solid 
model or wireframe. 

120 TOLERANCE a user-provided value in which to perfomi the calculations. 

M^o^Jt^rn^"^^ ^ user-defined character to tell the computer to skip this " 
TEACH FILE NAME is a file name in which to store all of the locations used. 

125 0.^^°^ ^^^^^ ^ ® ^^""^^^ ^ begimiing of the solid model. Typically 
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SOLID STOCK Extra Stock adds extra material or stock around the e<^es or diameto*. 

FANUC ARC CENTER to be calculated bom Absolute, incremental or radii given arc 
centers. 

The following paragraph is a description of the internal command set and malh 
1 30 used internally to calculate the Multi-axes Tool Compensation algorithm. These internal 
commands are listed below and shown by example: 

TOOLCOMPOFF 'Turns all compensation off. 

TOOLCOMPLEFT 'Comps tool in 2D to the left. 

TOOLCOMP RIGHT 'Comps tool in 2D to the right. 

135 TOOLCOMP 3DCOMP '30 comp based on vector and gouge parameter 
TOOLCOMP 3DADJUSTZ '3D comp lifts Z axis only but keeps X Y 
TOOLCOMP 3DOFFSET '3D parallel offset only - based on vector and no gouge 

'parameter. 

TOOLCOMP 5 AXIS 'S-axls comp based on vector and gouge parameter. 

140 TOOLCOMP LLIMIT45 'Give angle which will specify a gouge to omit tool 

'position. 

The TOOLCOMP command enables 3D and 5-axis tool condensation and has 
eight possible parameters: OFF, LEFT, RIGHT, 3DCOMP, 3DADJUSTZ, 3DOFFSET, 
5AXIS and LLIMIT45. The compensation value is taken fiom the tool parameter screen 
145 for that £fpecific tool number. 

The tool compensation is processed by the internal Multi-axes Tool 
Compensation algorithm when a file containing all of the locations are listed that 
correspond to a tool path along the original non-compensaled part to cut The positions 
of the original non-compensated tool path are loaded into memory. 



150 



If the tool size, height, wear, horizontal, vertical, comer radius, bottom angle, side 
angle, lengtii or type is changed in the boxes depicted in HG I. labeled by the same 
names or the user edits the positions in the file or A.K.A. the G code program to reflect a 
change in tool comp methods, then the program will automatically reprocess new re- 
calculated compensated tool position. 
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^ 55 A database is kept in the machine's memory of these positions plus ever changing 

conditions that it remembers by learning from what the machine can and cannot do. We 
regard this as an artificial intelligence algorithm element, which dynamically changes in 
realtime. 

If 3D or 5-axis tool comp is used, the file wiU need to include special codes on 
160 each line that will need to be compensated. The q)ecial codes are entered using Ae 

letters U,V,W or alteroately A3,C depending on the user's choice. The values following 
U,V,W or A3,C represent a normalized 3D vectorized value. Vectors are common 
mathematical properties representing a 3D magnitude of direction pointing in 3D space. 
The use, knowledge and values of vectors have been used and documented for hundreds 
165 of years and are regarded as common knowledge in the maAematical field. The vector 
used is derived fi^m the direction the original tool was at off the original part surfece at 
any given point in space. 

U,V,W are the end result of the compensated tool positions. 
D= the distance or combined length of FIG 2, Dim "A" Item 2, Dim "B" Item 3 and 
170 Dim "C" Item 4. 

Vx,Vy,Vz are the 3D vector component values. 
X,Y,Z is the original non-compensated tool position 

U = D* Vx + X 
175 V = D*Vy + Y 
W = D* Vz + Z 

The use of the L code represents a conical angle measured from the tool tip point 
to the nearest obstacle &om a flat 2D plane. If the user specifies an angle after LLIMIT, 
180 then the tool position move may be completely omitted by the machme if an obstacle is 
encountered on the part surface in order to automatically avoid gouging. 

L!= the value given after the LLIMIT command. 

L = (D/Sin(Lf)) 

If L < 0 Then skip this move. 

185 
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1 85 Else, combine this value with the D distance value to anive at a new distance to 
compensate. 

D=IX-L 

This occurs if on FIG 5. Dim "E" Item 7, which shows the included angle 
between the vector and the L code, is less than the value specified after LLIMIT. To turn 
1 90 gouge protection off, specify a zero value after LLIMIT 0. 

The following mathematical algorithms are based on three values hard coded into 
the routine. The user does not have a box to enter these values. Each machine style and 
head design dynamics determine the following three values used in the compensation 
195 algorithm. 



FIG 3. Item 5 depicts the key pivot point used in the algorithm. The resultant 
calculation affects the end position by further tilting the U,V,W in the view depicted in 
FIG 3. Item 5. 

FIG 4. Dim "D" Item 6 depicts the key angular displacement used in the 
algorithm. The resultant calculation affects the end position by further tilting the U,V,W 
in the view depicted in FIG 4. Dim "D" Item 6. 

FIG 6. Dim "R" Item 8 depicts the key rotational displacement used in the 
algorithm. The resultant calculation affects the end position by further rotating the 
U,V,W in the view depicted in FIG 4. Dim "D" Item 6. 



As such: 

210 Cz = CosCRz): Sz = Sin(R2): Cx = Cos(Rx): Sx = Sin(Rx): Cy = Cos(Ry): Sy = Sin(Ry) 
'Z rotate, counter clockwise 

Xl=U*Cz + V*Sz: Yl = U * -Sz + V * Cz-Zl = W 
T rotate, back 

215 X2 = X1: Y2 = Y1 *Cx + Zl*-Sx:Z2 = Yl *Sx + Zl*Cx 
'X rotate, left 

U = X2 Cy + Z2*-Sy:V = Y2:W = X2*Sy + Z2*Cy 
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